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Abstract of DE1 9940007 

The invention relates to a method and a device 
for supporting parking of a vehicle using a 
parking assistant. Signals concerning driving 
status supplied by sensors (2) are used to 
calculate a theoretical trajectory in a function 
block. Said trajectory consists of clothoid curves 
and/or a circular curves. Signals supplied by the 
sensors (2), in particular yaw angle signals and 
trajectory signals are used to calculate an actual 
trajectory in a function block (4). Theoretical and 
actual trajectories are then compared. The result 
of said comparison enables real-time calculation 
of the steering angle during the different phases 
of the parking maneuver for which a parameter is 
determined in a function block (5). Feed-back 
signals supplied by the sensors (2) enable exact 
regulation of the steering angle adopted during 
the parking maneuver. Steering wheel 
movements caused by the driver are tolerated 
but do not have any influence on the steering 
angle. The driver only has to press the 
accelerator and brake pedal to influence the 
speed of the vehicle. 



Data supplied from the esp@cenet database - Worldwide 


http://v3.espacenet.com/textdoc?DB=EPODOC&IDX=DE19940007&F=0 


3/26/2008 


I! III!! Ill III II HINNI III II Ml 


@ BUNDESREPUBLIK @ Offenlegungsschrift 

® DE 19940 007 A1 


DEUTSCHLAND 



© Int. CI. 7 : 

G 05 D 1/02 

B 62 D 6/00 


DEUTSCHES 
PATENT- UND 
MARKENAMT 


® Aktenzeichen: 
@ Anmeldetag: 
@ Offenlegungstag: 


199 40 007.5 
24. 8.1999 
8. 3.2001 


9 

O 

o 

CD 
UJ 

Q 


@ Anmelder: 

@ Erfinder: 

Robert Bosch GmbH, 70469 Stuttgart, DE 

Wetzel, Gabriel, 70435 Stuttgart, DE 

© Vertreter: 

© Entgegenhaltungen: 

Dreiss, Fuhlendorf, Steimle & Becker, 70188 

US 59 31 252 A 

Stuttgart 

US 51 81 173 A 


EP 09 31 712 A2 


EP 08 49 144 A2 


EP 08 35 797 A2 


EP 08 35 796 A2 


X 


X 


o 
o 

o 
o 


Did folgendan Angabon mind den vom Anmaldar eingereichten Unterlagan antnomman 

Prufungsantrag gem. § 44 PatG ist gestellt 

® Verfahren und Vorrichtung zur Unterstiitzung des Einparkens eines Kraftfahrzeugs 
_@- .DieErfindungbefasstsich.miYeinemAterfahrenund.ei- 
ner Vorrichtung zur Unterstiitzung des Einparkens eines 
Kraftfahrzeugs, d. h. mit einem Einparkassistenten. Aus 
von Sensoren (2) gelieferten Fahrzustandssignalen wird 
in einem Funktionsblock (3> eine Soil Trajektorie berech- 
net. Diese besteht aus Klothoidbogen und/oder Kreisbo- 
gen. Ferner wird auf der Basts der von den Sensoren (2) 
gelieferten Signals, insbesondere eines Gierwinkelsi- 
gnals und eines Wogesignals, eine Ist-Trajektorie in cinom 
Funktionsblock (4.) berechnet. Dann warden Soil- und Ist- 
Trajektorien verglichen, und das Vergleichsergebnis er- 
moglicht eine mit den Phasen des Einparkvorgangs 
schritthaltonde Berechnung des Lenkwinkels, fur den in 
einem Funktionsblock (5) eine StellgroBe ermittelt wird. 
Von den Sensoren (2) gelieferte Feed-back-Signale er- 
M moglichen eine genaue Regelung der wahrend des Ein- 
- parkvorgangs eingeschlagenen Lenkwinkel. Lenkradein- 
griffe des Fahrers warden toleriert, haben aber keine Aus- 
wirkung auf den Lenkwinkel. Der Fahrer muss lediglich 
Gas- und Bremspedal betatigen, um die Fahrgeschwin- 
digkeit des Fahrzeugs zu beeinflussen. 
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Beschreibung 
Stand derTechnik 

Die Erfindung hetrifft.ein Verfahren zur Unterstiilzung des Einparkens eines Kraftfahrzeugs, das mit einem Unkstcll- 
motor und Scnsorcn zum Erfassen der Fahrzeugposiuon, dcs Fahrzusiands und veranderlicher Umgebungsbedingungen 
ausgertlstet ist. wobei auf den Bcfehl eines Fahrers hin einc geregelte UnterstQlzung des Einparkvorgangs mittels des 
LcnksteUcrs und gestUtzt auf vorbestimmte Fahrzeugdatcn und auf Signale der Sensoren ausgefUhrt wird. sowie ein zur 
Durchfuhrung des Verfahrens eingerichleie Vorrichtung. 

Bei einem zur Zeit bei der Robert Bosch GmbH in der Entwicklung befindlichen elektronischen Lenksyslem wird 
durch cinen am Lenkgctriebe der Vorderrader angebrachtcn elektronisch geregelten Lenksteller, ausgchend von einem 
von einem Lcnkradsensor erf assten Fahrerienkwunsch unter Beriicksichtigung von fahrdynamischen Groflcn die Quer- 
dynamik durch eine Modifikadon des dem Fahrerienkwunsch entsprecheoden Lenkwinkels verbessert, d. h., dass das 
Fahrzeug in fahrdynamischen Situationcn stabilisiert wird. Das System weist einen Lenkstellmotor auf, der dem vom 
Fahrer gestellten Lenkwinkel einen Korrekturwinkel hinzuaddiert. 

Die DE 29 01 504 beschreibt ein Verfahren und eine Vorrichtung zum Einparken von Kraftfahrzeugcn, welche mit ei- 
ner reinen Steuerung des Einparkvorgangs arbeiteL Dabei werden keine den Verlauf derEinpark-Trajektorie vcrandernde 
Feed-Back-Signale beriicksichtigt, sondem statt dessen feste Trajektorien vorgegeben. 

Aus dem Patent. FR 2 728 859 ist ein Verfahren und eine Vorrichtung zur Regelung des Einparkvorgangs bekannt. Da- 
bei ist aber der Fahrer noch zustandig, urn Lenkcingriffe durchzufuhren. Dazu werden Sensoren verwendet, die den Gier- 
winkel und den Lenkwinkel erfassen. Unbefriedigend ist dabei, dass die Leistung des damit realisierten Systems durch 
die relativ groBe Tbtzeit des Fahrers bei den Lenkeingriffen beeintriichtigt ist. 

Aufgabe und Vorteile der Erfindung 

Es ist Aufgabe der Erfindung, cin Verfahren und cine Vorrichtung zur Untcrstutzung dcs Einparkens cincs Kraftf ahr- 
zeugs so zu ermoglichen, dass das Fahrzeug automatisch in die Parklucke lenkt, der Fahrer aber selbst durch Gaspedal- 
und Bremspedaleingriffe die Geschwindigkeit regelt. 

Die obige Aufgabe wird anspruchsgemafi gelost. 

GemaB einem wesentlichen Aspekt ist das die obige Aufgabe losende Verfahren gekennzeichnet durch folgende 
Schritte: 

A Erfassung ei ner das unterstutzte Einparken initiierenden Befehlseingabe des Fahrers und Erzeugung eines Inilia- 
lisierungssignals; 

B Erfassung der momentanen Fahrzeugposiuon und des Fahrzustands aus den Fahrzeugdaten und wenigstens aus 
einem Gierwinkelsignal und aus einem Wegesignal; 

C Erfassung der Umgebungsbedingungen aus von an dem Fahrzeug angebrachten Sensoren erzeugien Signalen; 
D Vorgabe einer oder mehrerer Soll-Tajektorien, die eine von der Fahrzeugposition, dem Fahrzustand, den Umge- 
bungsbedingungen und den Fahrzeugdaten abhangigc Soll-Bahnkurve des einzuparkenden Fahrzeugs angeben; 
E Erfassung cincr jcwciligcn Ist-Trajcktoric, abhangig von den jewcitigen in den Schrittcn B und C crfasstcn Si- 
gnalen; 

F Vergleich der in Schritt D vorgegebenen Soll-Trajektorie und der in Schritt E erfasstcn Ist-Trajektone; und 
G Berechnung der jeweiligen StellgroBe fur den Lenkstellmotor aus dem in Schritt F erhaltenen Vergleichscrgeb- 

nis." " — — 


Dabei wird das in Schritt B erfasste Wegesignal vorteilhafterweise von einem Weggeber, vorzugsweise von je einem 
an jedem Fahrzeugrad hefindlichen Rarigeschwindigkeitssensor, erfassl. Das ebenfalls in Schritt erfasste Gierwinkelsi- 
gnal kann entweder durch einen geeigneten Sensor gemessen werden oder aber aus geeigneten Signalen, bspw. aus der 
Drehrate eines Drehratensensors und/oder aus den Radgeschwindigkeitcn, rekonstruierl werden. 

Die Umgebungsbedingungen werden in Schritt C vorzugsweise mittels eines Ultraschallsensors erfaBt. Es ist jedoch 
audi denkbar Radarsensoren oder optische Sensoren, z. B. Kameras, einzusetzen. Die in Schrill C erfassten Umgebungs- 
bedingungen konnen die Form oder AusmaBc einer Parklucke angeben. 

Die oder jedc in Schritt D vorgegebene Soll-Trajektorie wird bevorzugt aus einem oder mehreren Klothoidbogen und/ 
oder aus einem oder mchrcrcn Krcisbogcn zusammcngesctzt. Ein Klothoid ist cine cbene Kurvc, dcrcn Krummungsra- 
dius gemaB der Beziehung R = a ■ a/s (R: Krummungsradius; s: Bogenlange; a: Parameter) steUg kleiner wird. 

Um zu vermeiden, dass die Lenkbcschleunigung und der Lenkruck zu hoch werden, wird die im Schritt E berechnete 
StellgroBe einer Filterung untcrworfen, die abrupte Obergange an den Flankcn der StellgroBe glattet. 

Eine zur Durchfuhrung des Verfahrens eingerichtetc Vorrichtung weist erfindungsgemaB eine Regei-/ Steuereinhcit, 
die von den Sensoren in Abhangigkeit von der Fahrzeugposition, dem Fahrzustand und den veranderlichen Umgebungs- 
bedingungen erzeugten Signale sowie die Fahrzeugdaten empfangt, Mitt el zur Berechnung einer Ist-Trajektorie aus den 
Sensorsignalcn und den Fahrzeugdaten, Miltel zum Vergleich der jeweils bcrechneten Tst-Trajektorie mil. einer vorbe- 
stimmtcn Soll-Trajektorie und Miltel zur Berechnung einer StellgroBe fUr cinen Lenkstellmotor aus dem Vergleichser- 
gebnis auf. 

Die das Verfahren (lurch fiihrende RcgcWSteucrcinhcil. kann iiber Filtcnnittel verftlgcn oder Uber Filtermitlel mit dem 
Lenkstellmotor vcrbunden sein, so dass die beiechnele StellgroBe in der oben beschricbenen Weise gefihert werden 
kann. 

Das oben spcziliziertc Verfahren und die Vorrichtung bieten gegenuber dem Stand der Technik mehrerc Vorteile: 
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- Es wird keine echte elektronische Steer-by-Wire-Lenkung bendtigl. Der bei dem in der Entwicklung befindlichcn 
fahrdynainischen Lenksystem eingcsetzle Lenkstcllraotor ist ausreichend, da er automatischc, genaue und sehr 
fcine Lcnkcingriffe enndglicht. 

- Die verwcndeten Sensoren cnnoglichcn einc genaue Berechnung der gefahrenen Bahnkurve und dainit eine ge- 
naue Regel ung des Einparkvorgangs mil slandigen Korrekluren und Anpassungen. 5 

- Die Auswahi der jeweiligen Soll-Trajektorie und ihre Kornbination aus Kiolhoidbogen und Kreisbogen ermog- 
licht eine einfache Beschreibung der Trajektoric und eine schnelle Berechnung des Vergleichsergebnisses zwischen 
Ist- und Soll-Trajektorie wUhrend des Einparkvorgangs. 

- Die durch die RegeWSleuereinheit ausgefuhrle Regelung ermoglicrH ein priizises Manover und lemporare Ab- 
weichungen von der Soll-Trajektorie, um den Fahrkomfort zu erhohen. 10 

- Die Filterung crhoht den Fahrkomfort, da sic ruckhafte Bcwegungen des Lenkrads glalten kann. 

Die nachstehende Beschreibung beschrcibt ein bevorzugtes Ausfuhrungsbeispiel des erfindungsgemaBen Verfahrens 
und erlautert gleichzcitig die Durchfuhrung durch die erfindungsgemiiBe Vorrichiung unter Bezug auf die beiliegendc 
Zeichnung. 15 

Zeichnung 

Fig. I 7eigl.schemat.isch Funklionsblockc der erfindungsgemaBen Vorrichiung; 

Fig. 2 zeigt graphisch die geomeLrische Grundlage zur Ermittlung einer Bahnkurve uber den Zusammenhang zwi- 20 
schen dem Krummungs radius R. dem Winkel 6 und dem Weg s; 

Fig. 3 zeigt graphisch ein Klothoid als ein Kurve, deren Krilmmung c(s) sich linear mil dem Weg s verandert; 

Fig. 4 veranschaulicfil in einer ebenen Darslellung eines Kraflfahrzeugs GroBen, die zur Bestiinmung der Kiolhoidbo- 
gen dicnen; 

Fig. 5 erlautert graphisch einc Trajektoric und einen Lenkwinkel fur eincn Fall, wo eine Fahrt am Lcnkcinschlag not- 25 
wendig ist; 

Fig. 6 zeigt graphisch cine Trajcktorie und einen Lenkwinkel fur einen Fall, wo keine Fahrt am Lenkeinschlag not- 
wendig ist; 

Fig. 7 zeigt eine mitdem dargestellten Aigorithmus erzielte Einpark-Trajektorie. 

30 

Ausfuhrungsbeispiel 

Das im nachfolgenden Text dargestellte Ausfuhrungsbeispiel eines erfindungsgemaBen Verfahrens zur Unterstiitzung 
des Einparkens eines Kraflfahrzeugs und einer zur Durchfuhrung des Verfahrens eingerichteten Vorrichiung (kurz: Ein- 
parkassistenl) verwendet insbesondere folgende Sensoren: 35 

- Ultragschallsensoren zur Erfassung der Umgebungsbedingungen; 

- aktive Radgeschwindigkeitsscnsoren, die Radgeschwindigkeitssignale bis zum Stillstand des Fahrzeugs liefera; 

- einen Lenkwinkelsensor; 

- cincn Drchratcnscnsor, mit dem Signalc ubcr die Gicrgcschwindigkcit crfassbar sind; und 40 

- (optionell) einen Querbcschleunigungssensor, 

Es isl denkbar, in einein anderen Ausfuhrungsbeispiel der vorliegenden Erfindung einen oder mehrere der beispielhaft 
. .angefiihrten Sensoren wegzulassen, entweder weil das crfindungsgemaBe.Verfahren auch ohne das von dem entsprechen-^ _ 
den Sensor gelieferte Sensorsignal voll funktionsfahig ist, oder weil das Sensorsignal aus anderen Sensorsignalen rekon- 45 
struiert werden kann. Welche Sensoren zur Durchfuhrung des erfindungsgemaBen Verfahrens tatsachlich eingesetzt wer- 
den kann von einem Fachmann anhand seines Fachwissens im Rinzelfall enlschieden werden. Es ware es bspw. denkhar, 
auf einen Drehratensensor zu vcrzichlen und das Drehratensignal aus anderen Sensorsignalen zu rekonstruieren. 

Fig. 1 zeigt Funkuonsblocke des Einparkassistentcn. Aus dem Block 1 stchen Fahrzeugdaten zur VerfUgung. Bei- 
spielsweise ist der Block 1 ein Speicher. in dem die Fahrzeugdalen abgespeichert sind. Eine alternative Moglichkeit ist 50 
ein Regel-/Sleuerwerk, das die Falirzeugdaten enlhalL Der Block 2 ist der Sensorblock, der die oben erwiihnten Sensoren 
umfasst. Der Funkuonsblock 3 berechnet die Soll-Trajektorie in der weitcr unten beschriebenen Weise und erhalt dazu 
die Fahrzeugdaten aus dem Block 1 und die Sensorsignale aus dem Block 2. 

Ein zur Ermittlung der Ist-Trajcktoric vorgcschcncr Funktionsblock 4 erhalt cbcnfalls die Fahrzeugdaten aus dem 
Block 1 und die Sensorsignale aus dcrn Block 2 als Eingangssignale. Insbesondere isl der Drehratensensor zur Rekon- 55 
struktion des Gierwinkels wichtig. Altemativ kann der Gierwinkcl auch durch einen cntsprechenden Gicrwinkelsensor 
gemessen werden. 

Die im Block 3 vorgegebene Soll-Trajcktorie und die im Block 4 ermittelte Ist-Trajektorie werden in einem Verglei- 
cher 8 vcrglichen. Aus dem Vergleichsergebnis und aus Signalen der Blocke 1 und 2 berechnet der Funktionsblock 5 die 
StellgroBe. Der Vergleich zwischen den Soil- und Ist-Trajektorien crmoglichl eine genaue Regelung des Lenkwinkel s 60 
miltels rier im Block 5 berechneten Stellgrofle. Diese Regelung ist. moglich, da die Lenkeingriffe von einer Regel-AStcu- 
creinheil ausgefiihrt werden. Die im Funktionsblock 5 bercchnclc StellgroBe wird im Funktionsblock 6 gefillert. Diese 
Fiilerung bewirkt eine GliiUung der Flanke der StellgroBe und errcicht daniit. class die Lenkbcschleunigung und der Ruck 
am Lenkrad nicht zu hoch werden. AuBcrdem werden dem Funktionsblock 6 auch Fahrzeugdalen aus dem Block I zu- 
gefuhrt und dort gefillert oder in die Filterung der StellgroBe mit einbezogen. 65 

In dem Vergleicher K konnen ncben der Ist- und der Soll-Trajcklorie auch Fahrzuslandssignale, bspw. die Orienticrung 
des Kraflfahrzeugs, niitcinander oder mit den Fahrzeugdalen vcrglichen werden. Der Funktionsblock 7 rcprasentiert cin 
Stcllglicd, das als cin Lcnkstcllmotor ausgcbildct isl. Die Sensoren und der Lcnkstellmolor konnen Teil cincs fahrdyna- 
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mischen Lenksystcnis des Kraft f ah rzeugs scin. Die zusatzlichcn Kosten fur cine crfindungsgemiiBe Vorrichtung in einem 
Kraftfahrzcug konnen so auf cin Minimum redzuiert werden. 

Die oben bezogen auf Fig. 1 beschriebenen Funktionen des Einparkassistenten konnen von einer Regel-/Steuercinheit, 
z U. einem ohnchin irn Fahrzeug vorhandenen Fahrzeugrechner ausgefiihrt werden. 

Nachstehenrl werden unter Rezug auf die Fig. 2 und 3 die geometrischen Grundlagcn zur firmilllung einer Trajektone 
auf der Basis eincs Klothoidbogens beschrieben. 

In Fig. 2 ist graphisch der Zusammenhang zwischen dein KrUinmungsradius R, dem Wmkel 9 und dcni Weg s einer 
bcliebigen Bahnkurve veranschaulicht. Fig. 2 zeigl. wie der Winkel 9 sich mil der Anderung des Wcgs s in Abhangigkeit 
vom Krummungsradius R verhall. Die Kruimnung c(s) ist mil Gleichung 1.1 gegeben: 


C(S) = 


de 
ds 


Gl. 1.1 


Der Winkel 9 bcrechnei sich aus dem Weg s anhand der folgcnden Glcichung: 

Gl. 1.2 


Diesc Gleichung laBl sich mil Hilfe der Gieichung 1.1 wie folgt ausdrucken: 

0 

Aus dem Winkel 6(s) werden die kleinen Anderungen (dx, dy) der kartesischen Koordinaten (x ; y) berechnet: 
'cos(e) • ds 

Gl. 1.4 


'dx(s)* 


dy(s). 



_sin(e) ■ ds. 
Die Koordinaten (x, y) werden aus der Gleichung 1 .4 abgeleitet: 






x 0 +}cos 

H< 

w)dw 


1 


< 





-dl 

o • 


> 



Gl. 1.5 


Die allgemeinc Gleichung 1.5 wird fur den speziellen Fall der Kiothoide vereinl'acht. Die Klothoide ist eine Kurve, de- 
ren Kriimmung c(s) sich linear mit dem Weg s verandert. Diese Kurve wird auch als Comu-Spirale (siehe Fig. 3) be- 
zel ch net. 

c(s) = k • s + c 0 Gl. 1.6 

Aus dem Einsalz der Krummung (siehe Gl. 1.6) in die Formel 1.5 ergibl sich: 


* f t \ 

x 0 +Jcos 6 Q +j{k'W^c 0 )'dyv Idt 

' f I \ 
y 0 +Jsin 0 o + J(k vv + cJ <fw -r/r 


Gl. 1.7 


was sich unter den Beriingungen: 
6o = 0. x ( , = 0 c 0 = 0, y 0 = 0 Gl. 1.8 
wie folgt veieinfachen lasst : 
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m- 


Gl. 1.9 


Die Integration der Funklionen sin(u 2 ) unci eos(u 2 ) ist niclu trivial. Dafiir wird die Reihenenlwicklung der Irigonome- 
trischen Funklionen aiigewamit. io 


ESI- 


( mi 


(2n) 


(2n + l) 


dt 


Gl. 1.10 


Untcr bestimmten Bcdingungcn von Konvcrgcnzcn dcr Rcihcn (Gl 1.10) kann die Rcihcnfolgc dcr Summc und dcr In- 
tegration invertiert werden. Diese Bedingungen sind in dern vorliegenden Ausfuhrungsbeispiel (Gl. 1.10) erfiillt. 


(2n) 


It-,' 
2 


{In + l) 


Gl. 1.11 


. Die QleichuggXl.il) lassi sich wie folgi transformieren: 


[401 


" k j 4 "* 1 

S ( " l)r, 2.(4n'l)-(2^ 


k • J 


1 ^'2-(4; 1 + 3).(2m + 1). 


Gl. 1.12 


55 


5 3 J» 

*~ 10*120 9360 

.11 13 


3 42 1320 75600 


• + t1 


685440 


6894720 


Gl. 1.13 


Die Gleicbung 1.13 dient dazu, bedeutende Punktedcr Trajcktorie schncll /m berechncn. Tin folgenden Abschnitt wird 
das Verfahren angcwandl, um eine Einpark-Trajektoric /.u bcrechncn, 

Wcitcrhin wird bczogen auf die Fig. 4 bis 7 die liinpark-Trajeklorie mil Hilfe cincs Algorithmic bcrcchnct, dcr auf dcr 
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vorangehcnd erliiuterten Gleichung 1.13 beruht. 

Intuiiiver Lenkvorgang 

5 Rs sei angenommen, dass das 7.u parkende Fahrzeug parallel zu der ParklUcke stehl. Die Trajektorie in dcr Langsrich- 
tung wird passend zu dcr existicrenden ParklUcke vorausgesetzt. Intuitiv soil die Einpark-Trajektoric die folgendcn Pha- 
scn beinhalten: 

I . Geradeaus ruckwiirls fahren, 
10 2. weiterfahren (eventuell langsamer) und das Lenkrad nach rechts bis zu dein Lenkeinschlag drehen, 

3. weitcr rUck warts fahren, 

4. Lenkrad nach links bis zum Lenkeinschlag drehen, 

5. weiter ruckwtirts fahren, 

6. Lenkrad wiedcr gerade stellen, und 
15 7. das Fahrzeug anhalten. 

Berechnung des Lenkwinkels 

Die oben beschriehenen intuitiven Phasen sollen formalisiert werden. 

20 - Wegen der einfachen Handhabung von Klothoiden wird angenommen. dass die Phasen 2. 4 und 7 Klothoid-Tra- 

jektorien sind. 

- Wegen der Symmetric des Einparkvorgangs sind die Phasen 2 und 6, 3 und 5 symmetrisch. 

Die Bestimmung der Phase 2 wird anhand der Fir. 4 hergeleilct. Die Klothoide sind durch cinen Parameter k be- 
25 stimrnU dcr auf der Begrenzung des Lenkwinkels und der Pahr- und Lenkgeschwindigkeiten beruht. 

Die Langc dcr Phase 3 ist so bcrcchnct, dass das Fahrzeug ticf genug in die ParklUcke fiihrt. Dcr Einfluss dicscr Langc 
auf die Trajektorie wird anhand der Fig. 6 und 7 dargestellt. Insbesondere zeigt die Fig. 6 die Trajektorie des Fahrzeugs, 
wenn die Phase 4 nichl exisuert. 

Die wichtigen Punkte fur die Berechnung der Trajektorie sind in den Fig. 5 und 6 mit den Buchstaben A, B, C, D, E, F f 
30 G, R gekennzeichnet. 

In Fig. 4 ist schematisch bei einem Fahrzeug mit eingeschlagenen Vorderradern der sich ergebende Radius R = l/c(s) 
und der Lenkwinkel 5(s) dargestellt. Die Klothoide ergibt sich zu 

c(s) = k • s+c 0 Gl. 2.1 

Der Ackermannwinkel ist 

5(s) = arctanfL • c(s)] Gl. 2.2 


c = tan 

- Daraus ergibt-sich: - 
k « s max s tan 


Gl. 2.3 


5 m. 
v 


Gl. 2.4 


50 Dies ergibt 


■»» = — . tan 
k 

Dcr Lenkwinkel ergibt sich zu: 

L-c 


L-k-v 


Gl. 2.5 


Gl.2.6 


6 = 


k-L- v* 


1+[L-C] 2 1+tL-c) 2 
Daraus erhait man den fur die Klothoide besiimmenden Parameter: 


k = 


Gl. 2.7 


L - v max 

Dabci findct cine Bcgrcnzung dcr Lenkwinkclgcschwindigkcit 8 < 8 M m " des Lenkwinkels 8 < 6 v m " und dcr Fahr- 
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geschwindigkeit v < v ma * stall. Das Ergebnis dcs Einparkvorgangs mit dem zuvor crlauterten Algorithnius ist in Fig. 7 
dargestellt, welche in eincm x-y-Koordinatensystern eine beispielhafte Einpark-TYajektorie und den zugrundeliegenden 
Soll-Lcnkwinkel veranschaulichl. 

Urn die Stcuerung iin Fahrzeug zu programmieren, wird der gefahrcne Weg benotigt. Im l ; ahrzeug wird dieser Weg 
mil akliven Rarigeschwindigkcitssensnren oder in vereinfachter Form mit Hilfe eines Weggehers gemessen. Die Radge- 5 
schwindigkeitssensoren kdnncn die Radgeschwindigkeii bis zur Cieschwindigkeit Null prazise erfassen. 

Bei dem oben bcschriebenen System darf der Fahrer wahrend des Einparkvorgangs Lenkeingriffe durchfilhren. Diese 
Lenkeingriffe haben aber keinen EinfluB auf das Manover. Falls beim Einparken ein Hindemis im Wege stent, soil der 
Fahrer bremsen und den Einparkvorgang sloppen. Da der Lenkradwinkel mil dem zugrundeliegenden Lenksyslem sen- 
sorisch erfasst wird, werden die Fahrereingriffe am Lenkrad durch den Lenkstellmotor wahrend des Einparkens kompen- l o 
siert. Dicse Vorgehensweise crmoglicht, dass der Fahrer trotzdem das Gefuhl hat, den Einparkvorgang selbst zu steuem 
und sich deshalb wohl fiihll. 

Aufgrund der vom Drehratensensor gelieferten Signale wird der Gierwinkel berechnet. Bei hochdynamischen Fahr- 
manovern kann diese Berechnung u. U. zeitlich problematisch sein. Beim Einparken treten dagegen in der Regel keine 
Schwierigkeiten auf, da sich die Fahrgeschwindigkeit und die Dynamik des Fahrmanovers in Grenzen hall. 15 

Somit ermoglicht der Einparkassistent iiber die Berechnung des Gierwinkels eine echte Regelung des Lenkwinkels 
durchzufuhren, damit die Fahrzeugoricntierung dem erwarteten Verhalten enlspricht. Mit dieser Regelung konnen Feh- 
ler, die zu einer Abweichung zwischen den gefahrenen und der berechnet en Trajektorie fOhren konnen, wie bspw. Fehier 
in der Txnkanlagc oder unterschiedliche Reihungen, korrigiert werden. 

Da der Sprung des dem Lenkstellmotor als StellgroBe zugefUhrten Signals zwischen den Phasen, in denen der Lenk- 20 
winkel konstant ist (Phasen 1, 3 und 5) und den Pbasen, in denen sich der Lenkwinkel verandert, zunachsl abrupt ist, wird 
die SlellgrtJBe in dem in Fig. 1 gezeigten Funktionsblock 6 gefiltert, indem die abrupten Sprtlnge der StellgroBe geglattet 
werden. Dabei kann die StellgroBe gefiltert werden, daiirit die Lenkbeschieunigung begrenzl isl. Da die SoU-TYajektorie 
unverandert bleibt, konnen Abweichungen von der Soll-Trajektorie auftreten. Es werden also temporare Abweichungen 
von der Soll-Trajektorie geduldet, um ein gleichfdrmiges Fahrmanover zu ermoglichen und urn dadurch den Fahrkom- 25 
fort zu crhohcn. Die Abweichungen zwischen der Soll-Trajektorie und der Ist-Trajcktoric werden im Laufc dcs Einpark- 
vorgangs durch die Regel-/ Steuereinheit mil Hilfe des erfindungsgemaBen Verfahrens korrigiert. 

Patentanspruche 

30 

1. Verfahren zur Unterstiitzung des Einparkens eines Kraftfahrzeugs, das mit einem Lenkstellmotor und Sensoren 
zum Erfassen der Fahrzeugposition, des Fahrzustands und veranderlicher Umgebungsbedingungen ausgeriistet ist, 
wobei auf den Refehl eines Fahrers hin eine geregelte Unterstiitzung des Einparkvorgangs mittels des T^nkstellers 
und gestulzt auf vorbestitnmte Fahrzeugdaten und auf Signale der Sensoren ausgefuhrt wird, gekennzeichnet 
durch folgende Schritte: 35 

A Erfassung einer das unterstUtzte Einparken initiierenden Befehlseingabe des Fahrers und Erzeugung eines 
Inilialisierungssignais; 

B Erfassung der momentanen Fahrzeugposition und des Fahrzustands aus den Fahrzeugdaten und wenigstens 
aus einem Gierwinkelsignal und aus cinem Wegcsignal; 

C Erfassung der Umgebungsbedingungen aus von an dem Fahrzcug angebrachten Sensoren crzeugten Signa- 40 
len; 

D Vorgabe einer oder mehrerer Soll-Tajektorien, die eine von der Fahrzeugposition, dem Fahrzustand, den 
Umgebungsbedingungen und den Fahrzeugdaten abhangige Soll-Bahnkurve des einzuparkenden Fahrzeugs 

_ angeben; . 

E Erfassung einer jcweiligen Ist-Trajektorie, abhangig von den jeweiiigen in den Schrittcn B und C erfassten 45 
Signal en; 

F Vergleich der in SchriU D vorgegebenen Soll-Trajektorie und der in Sennit. E erfassten Ist-Trajektorie; und 
G Berechnung der jeweiiigen StellgroBe fur den Lenkstellmotor aus dem in Schritt F erhaltenen Vergleichs- 
ergebnis. 

2. Verfahren nach Anspruch 1. dadurch gekennzeichnet, dass der Lenkstellmotor und zumindest ein Teil der Sen- 50 
soren Teil eines fahrdynamischen Lenksyslems des Kraflfahrzeugs sind. 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekennzeichnet, dass das in Schritt B crfasste Wegcsignal von je ei- 
nem an jedem Fahr/xugrad befindlichen Radgeschwindigkeitssensor erfasst wird. 

4. Verfahren nach eincin der Anspriichc 1 bis 3, dadurch gekennzeichnet. dass das in Schritt B crfasste Gierwinkel- 
signal von einem geeignetcn Sensor gemessen wird. 55 

5. Verfahren nach cinem der Anspriiche 1 bis 3, dadurch gekennzeichnet, dass das in Schritt B crfasste Gierwinkel- 
signal aus einem oder mehreren in den Schritten B und C anderweitig gemessenen Signalcn, insbesondere aus ei- 
nem Drehratcnsignal oder aus dem Wegesignal, rekonstruiert wird. 

6. Verfahren nach einem der vorangehenden Anspriiche, dadurch gekennzeichnet, dass die Umgebungsbedingun- 
gen in Schritt C mittels eines Ullraschallsensors erfasst werden. 60 

7. Verfahren nach einem der vorangehenden Anspriiche, dadurch gekennzeichnet, dass die in SchriU C erfassten 
Umgebungsbedingungen die Form und/odcr AusmaBe einer ParklUcke angeben. 

8. Verfahren nach eincin der vorangehenden Anspriiche, dadurch gekennzeichnet, dass die oder jede in Schritt D 
vorgegebene Soll-Trajektorie aus eincm oder mehreren KlothoidbSgen und/oder einem oder mehreren Krcisbogen 
zusammcngcsctzt werden. 6 $ 

9. Verfahren nach cinem der vorangehenden Anspriichc, dadurch gekennzeichnet, dass die im Schritt E bcrechnetc 
StellgroBe einer Filterung unterworfen wird, um zu vcrmeiden, dass die Lenkbeschieunigung und der Lenkruck zu 
hoch werden. 
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10. Verfahren nach eincm der vorangchenden Anspriiche, dadurch gekennzeichnet, dass Lenkeingrifle dcs Fahrers 
toleriert wcrden, aber keinen Einfluss auf den Einparkvorgang nehnien. 

11. Verfahren nach einem der vorangehenden Anspriiche, dadurch gekennzeichnet, dass die Einparkgcschwindig- 
kcitdurch Gas- und Bremspedaleing rifle des Fahrers beintlusst und die Lenkwinkel ausschlielilich durch die Stcll- 
hewegungen dcs I .enkstellmotors hewirkt werden. 

12. Vorrichtung zur Durchfuhrung des Verfahrens nach cinern der vorangehenden Anspriiche, dadurch gekenn- 
zeichnet, dass die Vorrichtung eine Regel-/Steuercinhcil. die von den Sensoren in Abhangigkeit von der Fahrzeug- 
posidon, dem Fahrzustand und den verSinderlichen Umgebungsbedingungen erzeugten Signale sowie die Fahrzcug- 
dalen empfangl, Millel zur Berechnung einer Ist-Trajeklorie aus den Sensorsignalen und den Fahrzeugdalen, Miltel 
zum Vergleich der jeweils berechneten Ist-Trajektorie mit einer vorbestimmten Soli-Trajektoric und Mittel xur Be- 
rechnung einer StellgroBc fur einen Lenkstellmotor aus dem Vergleichsergebnis aufweisl. 

13. Vorrichtung nach Anspruch 12, dadurch gekennzeichnet, dass die RcgcWSleuereinheit die von den jcweiligen 
Sensoren erzeugten Signale sowie die Fahrzeugdaten von einer anderen Steuer-ZRegeleinheit in dem Fahrzeug emp- 
fangt. 

14. Vorrichtung nach Anspruch 13, dadurch gekennzeichnet, dass die andere Steuer-/Regeleinheit als ein fahrdyna- 
misches Lenksystem des Fahrzeug s ausgebildet ist. 

1 5. Vorrichtung nach einem der Anspruch 12 bis 14, dadurch gekennzeichnet, dass Filtennittel in funktioneller Vcr- 
bindung mit der Regel-/Stcucreinhcit vorgesehen sind, urn die von der RegeWSteuereinheit berechnetc StcllgroBe 
so zu filtern, dass die T^cnkbeschleumgung und der Tenkruck nicht zu hoch werden. 
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